Title: "CONTROLLER OF LEGGED MOBILE ROBOT' 
First Named Inventor: Tom Takenaka 
National Stage of PCT/JP2004/009477 
Customer No. 40854; Docket No. SAT-16312 
Page 1 of 8 
REPLACEMENT SHEET 



FIG.3 



60 

A 



90 80 



1ST CALCULATION 
UNIT 



92 



2ND CALCULATION 
UNIT 



82 
94 



/ 



ROM 



84 



RAM 



A/D 



86 



COUNTER 



96 



D/A 



JOYSTICK 



POSTURE SENSOR 



SIX-AXIS FORCE 
SENSOR 



ENCODER 



MOTOR 



I 



SERVO AMPLIFIER 



Title: "CONTROLLER OF LEGGED MOBILE ROBOT' 
First Named Inventor: Toru Takenaka 
National Stage of PCT/JP2004/009477 
Customer No. 40854; Docket No. SAT-16312 
Page 2 of 8 
REPLACEMENT SHEET 




Title: "CONTROLLER OF LEGGED MOBILE ROBOT' 
First Named Inventor: Toru Takenaka 
National Stage of PCT/JP2004/009477 
Customer No. 40854; Docket No. SAT-16312 
Page 3 of 8 
REPLACEMENT SHEET 



FIG.17 



NEXT TIME'S GAIT 
SUPPORTING LEG 
COORDINATE 
SYSTEM 

Y' 



Xe=Xs 




-22R 

CURRENT TIME'S GAIT 
SUPPORTING LEG 
COORDINATE 
SYSTEM 



Ye=Ys 

22R 

NEXT BUT ONE TIME'S GAIT 
SUPPORTING LEG 
COORDINATE 
SYSTEM 



BODY TRAJECTORY OF NORMAL GAIT 

(FIRST TURNING GAIT + SECOND TURNING GAIT) 



Title: "CONTROLLER OF LEGGED MOBILE ROBOT" 
First Named Inventor: Toru Takenaka 
National Stage of PCT/JP2004/009477 
Customer No. 40854; Docket No. SAT-16312 
Page 4 of 8 
REPLACEMENT SHEET 



C ENTRY ^) 



FIG.42 



S700 



oo 



CALCULATE PROVISIONAL CURRENT TIME GAIT UNTIL END TIME ON THE BASIS OF 
PROVISIONAL DESIRED ZMP AND OTHER CURRENT TIME GAIT PARAMETERS. 
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DETERMINE TERMINAL DIVERGENT COMPONENT qO[k] ACCORDING TO THE FOLLOWING 
EQUATION FROM BODY POSITIONAELOCITY (Xe,Vxe) AT END OF CURRENT TIME GAIT. 

qO[k] = Xe + Vxe/cuO 
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DETERMINE TERMINAL DIVERGENT COMPONENT ERROR errq 
ACCORDING TO THE FOLLOWING EQUATION: 
errq = qO[k] - q" 
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CALCULATE PROVISIONAL CURRENT TIME GAIT UNTIL END TIME ON THE BASIS OF DESIRED ZMP 
OBTAINED BY ADDING CORRECTION TO PROVISIONAL DESIRED ZMP ACCORDING 
TO RELATIONSHIP OF FIG. 44, ASSUMING THAT a= A a. 
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DETERMINE TERMINAL DIVERGENT COMPONENT ql [k] ACCORDING TO THE FOLLOWING EQUATION 
ON THE BASIS OF BODY POSITIONAELOCITY (Xel ,Vxel ) AT END OF CURRENT TIME GAIT 
RECALCULATED ON THE BASIS OF DESIRED ZMP TO WHICH CORRECTION HAS BEEN ADDED: 

ql[k] = Xel+Vxel/coO 



DETERMINE PARAMETER SENSITIVITY r ACCORDING TO THE FOLLOWING EQUATION: 
r = (q1[k]-qO[k])/AQ 
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ADD CORRECTION AMOUNT BASED ON a=-errq/r TO PROVISIONAL 
DESIRED ZMP TO PROVIDE UPDATED PROVISIONAL DESIRED ZMP. 
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DETERMINE BODY INCLINATION RESTORING MOMENT ZMP-CONVERTED VALUE PATTERN ON THE BASIS OF 
DIFFERENCE BETWEEN TERMINAL BODY POSTURE ANGLE OF PROVISIONAL CURRENT TIME GAIT AND INITIAL 
BODY POSTURE ANGLE OF NORMAL GAIT AND DIFFERENCE BETWEEN TERMINAL BODY POSTURE ANGULAR 
VELOCITY OF PROVISIONAL CURRENT TIME GAIT AND INITIAL BODY POSTURE ANGULAR VELOCITY 
OF NORMAL GAIT. 



DETERMINE, AS DESIRED ZMP PATTERN, THE PATTERN OBTAINED BY ADDING BODY INCLINATION 
RESTORING MOMENT ZMP-CONVERTED VALUE PATTERN TO PROVISIONAL DESIRED ZMP PATTERN. 
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DETERMINE ANTIPHASE ARM SWING RESTORING ANGULAR ACCELERATION PATTERN ON THE BASIS 
OF DIFFERENCE BETWEEN TERMINAL ANTIPHASE ARM SWING ANGLE OF PROVISIONAL CURRENT TIME 
GAIT AND INITIAL ANTIPHASE ARM SWING ANGLE OF NORMAL GAIT AND DIFFERENCE BETWEEN TERMINAL 
ANTIPHASE ARM SWING ANGULAR VELOCITY OF PROVISIONAL CURRENT TIME GAIT AND INITIAL 
ANTIPHASE ARM SWING ANGULAR VELOCITY OF NORMAL GAIT. 
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DETERMINE DIFFERENCE IN HORIZONTAL BODY POSITION BETWEEN MODELS, 
WHICH IS THE DIFFERENCE BETWEEN HORIZONTAL BODY POSITION OF 
CORRECTED GAIT AND HORIZONTAL BODY POSITION OF ORIGINAL GAIT. 
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DETERMINE DIFFERENCE IN BODY POSTURE INCLINATION ANGLE BETWEEN MODELS, 
WHICH IS THE DIFFERENCE BETWEEN BODY POSTURE INCLINATION ANGLE OF CORRECTED 
GAIT AND BODY POSTURE INCLINATION ANGLE OF ORIGINAL GAIT. 
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DETERMINE DIFFERENCE IN ANTIPHASE ARM SWING ANGLE BETWEEN MODELS, 
WHICH IS THE DIFFERENCE BETWEEN ANTIPHASE ARM SWING ANGLE OF 
CORRECTED GAIT AND ANTIPHASE ARM SWING ANGLE OF ORIGINAL GAIT. 
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DETERMINE REQUIRED VALUE OF MODEL HORIZONTAL BODY POSITION STABILIZATION FLOOR 
REACTION FORCE MOMENT NECESSARY TO CONVERGE DIFFERENCE TO ZERO ON THE BASIS OF 
DIFFERENCE IN HORIZONTAL BODY POSITION BETWEEN MODELS. 
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DETERMINE REQUIRED VALUE OF MODEL BODY POSTURE INCLINATION ANGLE STABILIZATION 
FLOOR REACTION FORCE MOMENT NECESSARY TO CONVERGE DIFFERENCE TO ZERO ON THE BASIS 
OF DIFFERENCE IN BODY POSTURE INCLINATION ANGLE BETWEEN MODELS. 



DETERMINE REQUIRED VALUE OF MODEL ANTIPHASE ARM SWING ANGLE STABILIZATION FLOOR 
REACTION FORCE MOMENT NECESSARY TO CONVERGE DIFFERENCE TO ZERO ON THE BASIS OF 
DIFFERENCE IN ANTIPHASE ARM SWING ANGLE BETWEEN MODELS. 
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DETERMINE MODEL HORIZONTAL BODY POSITION STABILIZATION MOMENT, MODEL BODY POSTURE ANGLE 
STABILIZATION MOMENT, MODEL ANTIPHASE ARM SWING ANGLE STABILIZATION MOMENT, HORIZONTAL 
BODY ACCELERATION, BODY POSTURE ANGULAR VELOCITY, AND ANTIPHASE ARM SWING ANGULAR 
ACCELERATION SUCH THAT THEY SATISFY RESTORING CONDITIONS. 



MODEL MANIPULATION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT 
= MODEL HORIZONTAL BODY POSITION STABILIZATION MOMENT 
+ MODEL BODY POSTURE ANGLE STABILIZATION MOMENT 
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= COMPENSATING TOTAL FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT Mdmdxy 
+ MODEL MANIPULATION FLOOR REACTION FORCE MOMENT HORIZONTAL COMPONENT 
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